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Angular Velocity Observer on the Special Orthogonal Group for 
Velocity-Free Rigid-Body Attitude Tracking Control 

Tse-Huai Wu and Taeyoung Lee* 


Abstract —This paper studies a rigid body attitude tracking 
control problem with attitude measurements only, when angular 
velocity measurements are not available. An angular velocity 
observer is constructed such that the estimated angular velocity 
is guaranteed to converge to the true angular velocity asymp¬ 
totically from almost all initial estimates. As it is developed 
directly on the special orthogonal group, it completely avoids 
singularities, complexities, or discontinuities caused by minimal 
attitude representations or quaternions. Then, the presented 
observer is integrated with a proportional-derivative attitude 
tracking controller to show a separation type property, where 
exponential stability is guaranteed for the combined observer 
and attitude control system. 

I. Introduction 

The problem of attitude control of a rigid body is one of 
the most popular research topics in control theory and prac¬ 
tice. The corresponding applications include aerial and un¬ 
derwater vehicles, robotics, and spacecraft dynamics. Many 
approaches have been studied in the attitude control problem 
to address various technical challenges [1], [2], [3], [4]. In 
most of the attitude control strategies, full states measure¬ 
ments, i.e., both attitude and angular velocity measurements, 
are required. However, angular velocity measurements are 
not available in certain cases, for example, due to limited 
sensing, power availability, and costs. 

Several approaches have been proposed for attitude con- 
Uols without angular velocity measurements, where the value 
of the angular velocity is estimated. A nonlinear angular 
velocity observer is presented by Salcudean in [5], to con- 
sttuct an estimated angular velocity in terms of the attitude 
measurements based on an observer designed for a second- 
order linear system. However, the observer is designed and 
analyzed separately from attitude control systems, assuming 
that there is a separation principle-like property, i.e., it is 
assumed that the convergence of the controller is independent 
of the observer design. Recently, a switching-type angular 
velocity observer is presented to show stability of an attitude 
control system in terms of quaternions [6]. 

There are other attitude control techniques that do not re¬ 
quire an estimate of the angular velocity. An auxiliary system 
approach is proposed based on the passivity property [7], 
[8], where the auxiliary system generates a damping term 
similar to a derivative term that is directly dependent on the 
angular velocity [1], Additionally, a hybrid attitude tracking 
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controller is proposed in the absence of angular velocity 
information [9], and a velocity-free adaptive controller is 
developed for rigid-body attitude tracking [10]. 

Most of these prior works on angular velocity observers 
and velocity-free attitude controls are constructed in terms 
of local parameterizations of the attitudes, or quaternions. 
Attitude control systems based on minimal representations, 
such as Euler angles or modified Rodrigues parameters, 
suffer from singularities in representing large angle rotational 
maneuvers. Quaternions do not have singularities. However, 
since the configuration space of quaternions, represented by 
three-sphere double-covers the attitude configuration space of 
the special orthogonal group, one physical attitude actually 
corresponds to two antipodal quaternions. This ambiguity 
should be carefully resolved for any quaternion-based atti¬ 
tude control system to avoid undesirable phenomena such as 
unwinding, where a rigid body unnecessarily rotates through 
a large angle, even if the initial attitude error is small, or 
it may become sensitive to small measurement noise [11], 
[ 12 ]. 

This paper follows the first type of approaches that are 
based on an estimated value of the angular velocity. An 
angular velocity observer is constructed directly on the 
special orthogonal group, and it is shown that the zero 
equilibrium of the estimation errors are almost globally 
asymptotically stabile, i.e., it is asymptotically stable and 
the region of attraction only excludes a set of zero Lebesgue 
measure [2], The second part of this paper is devoted to a 
separation type property by integrating the proposed angular 
velocity observer with a separately designed attitude tracking 
control system. It is shown that the combined system yields 
exponential stability. 

Compared with the prior work [5], [6], the angular veloc¬ 
ity observer presented in this paper completely avoids the 
aforementioned issues of quaternions. Furthermore, in the 
switching-based angular velocity observer [6], the observer 
performance depends on the mass distribution of the rigid 
body, since the convergence rate becomes slower and the 
number of switching increases as the rigid body becomes 
more elongated. Frequent switching may cause undesired 
behaviors or even instability as illustrated by numerical 
examples presented later in this paper. The main contribution 
of this paper can be summarized as (i) developing an angular 
velocity observer on the special orthogonal group to avoid 
the issues of quaternions and the dependency of convergence 
rates on the shape of a rigid body, and (ii) showing a 
separation property mathematically rigorously and explicitly 
without need for discontinuities caused by switching. To au- 



thor’s best knowledge, a separation-type property of attitude 
controls and angular velocity estimation has not been studied 
before without a switching logic. 

The paper is organized as follows. A rigid-body dynamic 
model is introduced at Section II. An angular velocity 
observer is presented at Section III and a separation-type 
property is shown at Section IV, followed by numerical 
examples at Section [V] 


II. Rigid Body Attitude Dynamics 


A. Estimate Frame 

Define an orthonormal frame estimated by the observer. 
The attitude and angular velocity of the estimate frame with 
respect to the inertial reference frame are denoted by R £ 
S0(3) and uj £ R 3 , respectively. More explicitly, R denotes 
the linear transformation from the inertial reference frame to 
the estimate frame. The discrepancy between the true attitude 
R and the estimated attitude R is denoted by a rotation matrix 
Qe £ S0(3), where 

Qe = RR T - (6) 


Consider the attitude dynamics of a fully-actuated rigid 
body. Two coordinate frames are defined: an inertial ref¬ 
erence frame and a body-fixed frame. The attitude of the 
rigid body is denoted by R £ SO(3) that represents the 
transformation of a representation of a vector from the body- 
fixed frame to the inertial reference frame. The configuration 
manifold of attitude is the special orthogonal group: 

S0(3) = {R £ R 3x3 | R J R = I , det [R] = 1}. 

Let uj £ R 3 and Q £ R 3 denote the angular velocity of the 
rigid body with respect to the inertial reference frame and 
the body-fixed frame, respectively. The governing equations 
for the rigid body attitude dynamics are given by 

j t (Ju) = T, J = RJ 0 R T , (1) 

R = CjR = Rtl, (2) 

where Jq £ R 3x3 is the fixed inertia matrix expressed in 
body-fixed frame and r is the control moment expressed in 
the inertial reference frame. Note that the equation of motion 
for the angular velocity, 0 is represented with respect to 
the inertial frame. In addition, the hat map A : R 3 — > so(3) 
transforms a vector in R 3 to a 3 x 3 skew-symmetric matrix 
such that xy = x A y = x x y for any x, y £ R 3 . And the 
inverse of hat map is denoted by the vee map V : so(3) —> 
R 3 . Several properties of hat map are listed as follows: 

tr[A£] = tr [xA\ = — x T {A — A T ), (3) 

RxR J = (Rx) A , (4) 

xA + A J x = ({tr[A]/ 3x3 - A}cc) A , (5) 

for any x £ R 3 , A £ R 3x3 , R £ S0(3). The standard inner 
product of two vectors is denoted by x-y = x T y. Throughout 
this paper, / :4 x .i denotes the 3x3 identity matrix and the 2- 
norm of matrix A is denoted by ||A||. Also, Am and A m 
are defined as the maximum eigenvalue and the minimum 
eigenvalue of the inertia matrix Jq, respectively. 

III. Angular Velocity Observer on S0(3) 

In this section, an observer is constructed such that the 
angular velocity is estimated when the attitude measurements 
and the control input are available. 


Note that Qe = / 3x3 when R = R. 

To further describe the error dynamics between R and R, 
the estimate error variables are defined as follows: 


-tr[G£(/ 3x3 - Qe)\, 

(7) 

1 -(Q e Ge-G e Q t e Y , 

(8) 

w = Joj- JO, 

(9) 


where d/# £ R, 6r e £ R 3 and e UE £ R 3 denote the estimate 
error function, attitude estimate error vector and estimate 
angular velocity error, respectively. The matrix Ge is defined 
as Ge = diagfei, e 2 , e 3 ] £ R 3x3 where ei,e 2 ,e 3 £ R are 
distinct positive constants. 


B. Observer Design 

The observer dynamics are defined as 


±(Ju)=T + \k„J 


-1 


^ Re i 
A 


R — \QRe(uj -\- k v J 1 eR E )\ R , 


( 10 ) 

(ID 


where k E , k v £ R are positive constants. The observer is 
designed in the inertial reference, and it can be transformed 
to the body-fixed frame easily since the attitude is assumed 
to be available. 

The estimate error variables along the solution of the above 
observer dynamics satisfy the following properties. 

Proposition 1: The estimate error variables Qe, ^e, s,r E i 
and e^ E satisfy: 

(i) is positive definite about R = R. 

(ii) Let the positive constants n\ ,..., ns be 

m = min{ei + e 2 , e 2 + e 3 , e 3 + ei}, (12) 

n 2 = max{(ei - e 2 ) 2 , (e 2 - e 3 ) 2 , (e 3 - ei) 2 }, 
n 3 = max{(ei + e 2 ) 2 , (e 2 + e 3 ) 2 , (e 3 + n) 2 }, 

77,4 = max{ei + e 2 , e 2 + e 3 , e 3 + e 4 }, 

n 5 = min{(ei + e 2 ) 2 , (e 3 + e 3 ) 2 , (e 3 + n) 2 }, 


and let ipE < ti\- The error function T^ is locally 
quadratic, i.e.. 


7li 


\ e RE 


I 2 < < 


77-i?7.4 


Wl 2 , (13) 


n 2 + n 3 " n 5 (ni-ipE) 

where the upper bound is satisfied when T /.; < lf>E- 
(hi) Qe = iAjeQe, 

(iv) it E = u T E e RE , 





(14) 


(v) e RE = E 0 (R,R)u e , 

(vi) e WE = 

where uje £ K 3 and E 0 (R,R) € R 3x3 are given by 
we = w — <*> — k v J~ lr 


e R E 


1 


E 0 (R,R ) — -(tr[Q s ]J 3X 3 - 2ep E - G E Q E )• 


(15) 


Proof: It is known that — 1 < tr[A] * 3, for any rotation 
matrix R G S0(3), then it is clear that 'Tp > 0 and (I/p = 0 
only happens at Qe = / 3x3 , which verifies (i). To show (ii), 
the following properties in [13] are applied: For non-negative 
constants fi, f 2 , f 3 , let F = diag[/i, f 2 , / 3 ] £ 

P G SO(3). Define 


3x3 


$ = -tr[F(/ 3X 3--P)], 

e P = ^(FP-P J F) V . 


and let 

(16) 

(17) 


Then, <1» is bounded by the square of the norm of ep as 

hi || n 2 -r h\hi 


ep < $ < 


ep 


^2 + ^ 3 " " h 5 (hi - f) 

If 4) < f < hi for a constant <j>, where h t are given by 


(18) 


hi = minf/! + f 2 , f 2 + f 3 , / 3 + fi}, 
h 2 = max{(/i - / 2 ) 2 , (/ 2 - / 3 ) 2 , (/ 3 - A) 2 }, 
h 3 = max{(/i + / 2 ) 2 , (/ 2 + / 3 ) 2 , (/ 3 + /1) 2 }, 
hi = max{/i + / 2 , / 2 + / 3 , / 3 + /1}, 

/i 5 = mm{(/! + / 2 ) 2 , (/ 2 + / 3 ) 2 , (/ 3 + A) 2 }. 


Now, we choose F = G E and P = Qe, we then have <I> = 
Tp, e P = c R e , f = fiE and hi = n», for i = {1,2,..., 5}. 
This shows (ii). 

From {2} and ( | 1 1[ ), the time-derivative of Qe is 
Qe = uRR J - RR t [Q t e {lo + k v J- 1 e Rli )] A . 

Using 0 and it is rearranged as 

Qe = uQ e — QeQ T e{u + k v J 1 en B ) A Q E 
= (u — u — k v J~ 1 e RE ) A Q E = &eQe, 


which shows (iii). 

Next, the time-derivative of T'p is 

^ e = — ^ti \Q e Ge\ 

= —^tr[(w — u> — k v J~ 1 e RE ) A Q E G E \. 

From ([3]), it is rewritten as 

’i'p = 2 ( w — ^ — k v J 1 e RE ) T (Q e Ge — g e q t e Y 

= (w-ui- k v J~ 1 e RE ) T e RE = u T E e RE , 

which shows (iv). Next, according to ([5]) and 0, the time- 
derivative of e RE is 

ep E = 2 {ueQeGe + GeQ t e u E ) 

= 2 {^[QeG E ]I3x3 — QeGe)we 


— 2 (MQ-eKsxs — 2 Br e - G E Q T E )u E , 

which shows (v). Finally, from 0.0 and ( fTO} , we have 

- J t ( j ^ = T - ( r + ^s<7 _1 epj, 

which shows (vi). ■ 

Next, we show that the zero equilibrium of the estimate 

error variables is almost globally asymptotically stable. 

Proposition 2: Consider the system given by 0, 0 
with the angular velocity observer given by {0, 0). The 
following properties holds: 

(i) There are four equilibrium configurations, given by 

(R,w)e{{R,u),{D i R,w)}, (19) 

for i = 1,2,3, where Di = diag[l, —1, —1], D 2 = 
diag[—1,1, -1] and D 3 = diag[-l, -1,1]. 

(ii) The desired equilibrium (R, to) = (R, ui) is almost 
globally asymptotically stable. 

(iii) The remaining three undesired equilibrium configura¬ 
tions are unstable. 

Proof: The equilibrium configurations happen at 

(ep E ,e WE ) = (0,0). Clearly, in view of 0, e WE = 0 
yields oj = uj. From 0, e RE = 0 directly implies that 
QeGe — G e Qe = 0, which follows that either Q E = / 3x3 
or tr[Qp] = —1 [14, Theorem 5.1]. Therefore, 

Qe = RR J £{7 3x3 , Di, D 2 , D 3 }, 

which shows (i). 

Consider the following Lyapunov function, 

G = el E e “E + kE^E, (20) 

which is positive definite about ( e UE ,e RE ) = (0,0). From 
the properties (iv) and (vi) of Proposition [I] the time- 
derivative of U is given by 

U = 2 el E e WE + k E i>E 

= 2e^ E (--fcpJ _1 ep E ) + (w - u) - k v J _1 ei ?E ) T e flE 

= —k E k v ep (J~ 1 e RE ) < -fc B fc„- l -||ep E || 2 . (21) 

Am 

Hence, one can conclude that e ulE , e RB are globally bounded 
and lim t _ > , 00 ||ep E || = 0. Further, one can show that ||Qp|| 
is bounded and lim t _ i . 00 f* ||Qp|| dt' = lim^oo ||Qe|| exits. 
From Barbalat Lemma, we conclude that 

lim HQeII = lim ||w - w - k v J~ 1 e RE || = 0. (22) 

t—f OO t—foo 

Since lim^oo ||ep E || = 0, it is clear that lirn^oo ||w — w|| = 
0, and this implies lim^oo |||| = 0. Consequently, the 
equilibrium (ep^e^) = (0,0) is asymptotically stable. 

However, the fact that lim^oo e RE = 0 does not necessar¬ 
ily imply that the estimated attitude asymptotically converges 
to the tme attitude. Instead, it asymptotically converges to 
either the true attitude or one of the three undesired equilibria 
given by RI), for 1 < i < 3. 




Next, we show the undesired equilibria are unstable. At the 
first undesired equilibrium R = RD i, we have 'I 'e = £2+63- 
Define W = fc_E)(e 2 + £ 3 ) — U , or 

W = /cs(e 2 + £3 — ’J'.e) — || e w E || 2 - 

Then, W = 0 at the undesired equilibrium. Due to the 
continuity of T /?, in an arbitrarily small neighborhood of 
RDi in S0(3), there exists R such that (e 2 + £ 3 ) — T'# > 0. 
For such attitudes, we can guarantee that W > 0 if ||e WB || 
is sufficiently small. In other words, at any arbitrarily small 
neighborhood of the undesired equilibrium, there exists a 
domain, namely U such that VV > 0 in U. And we have 
TV = —U > 0 from ( |Ti~[ ). According to Theorem 3.3 
at [15], the undesired equilibrium is unstable. The instability 
of the other two equilibrium configurations can be shown 
by the similar way. This shows the almost global asymptotic 
stability of (ii) as well as (iii). ■ 

The presented angular velocity observer guarantees that 
the estimation errors asymptotically converge to zero for 
almost all initial estimates, i.e., the region of attraction 
excludes only a thin set of zero measure. This is the 
strongest stability property for any continuous angular ve¬ 
locity observer, due to the topological restriction stating that 
it is impossible to achieve global attractivity in the special 
orthogonal group unless discontinuities are introduced. 

In contrast to the prior work given by [6] where the the ra¬ 
tio of 4 51 has a crucial impact on the observer performance, 
the convergence property of the proposed angular velocity 
observer is independent of the mass distribution of the rigid 
body. 

IV. Attitude Tracking without Angular 
Velocity Measurements 

In this section, we show a separation property of the angu¬ 
lar velocity observer developed in this previous section with 
a proportional-derivative attitude tracking control system on 
SO(3). 

A. Attitude Tracking Controls 

We first review a attitude tracking controller developed on 
SO(3) [16, Sec. 11.4.3] and [3]. Suppose the desired attitude 
Rd(t) £ SO(3) and the desired angular velocity f ld(t) £ R 3 
are given as smooth functions of time, and they satisfy the 
kinematic equation Rd = Rd&d- Let Q £ SO(3) be the 
relative attitude of the desired attitude with respect to the 
current attitude of the rigid body, i.e., 

Q = R J R d g SO(3), 

The attitude tracking error variables are defined as 


*= ^tr[G(I 3x3 -Q)], 

(23) 

e R = \(GQ J - QG)\ 

(24) 

— Q QQdi 

(25) 


tracking angular velocity error, respectively. The matrix G = 
diag[< 7 i, < 72 , < 73 ] G R 3x3 where g ll g 2 ,g 3 G R are distinct 


positive constants. 

The corresponding error dynamics are given as 

'L = e^en, (26) 

e-R = E c (Q)en, (27) 

Joe ft — 'll -b X^fl JQ&d QQdJoQ^ch (28) 

where E C (Q) G M 3x3 and x £ are defined as 

Ec{Q) = \^[QG)I 3x3 - QG), (29) 

X = Jo^n + (2 Jq — trfJoj/sxa)*?^, (30) 


and u £ R 3 is the control moment expressed in the body- 
fixed frame, i.e., u = R t t. Detailed analysis of the error 
variables has been addressed in [3], [4], [16]. 

A proportional-derivative (PD) type controllers on SO(3) 
is introduced as below. 

Proposition 3: ([3], [4], [16]) Consider the attitude dy¬ 
namics given by 0- 0 For positive constants kR, ka £ M, 
let the control input be 

u — kReR k^CQ -f J^Qtld 4- QTld(JoQ^d')- (31) 

Then, the zero equilibrium of the tracking errors (c; e< >) is 
almost globally asymptotically stable. 

B. Separation-Type Property 

The above PD-type attitude tracking control system re¬ 
quires that the angular velocity of the rigid body is available 
always. Here we show that the angular velocity observer 
presented at Section m satisfies a separation property when 
combined with the PD-type controller. 

Suppose that the true angular velocity f i is not available to 
the control system, and the angular velocity estimated by the 
presented observer is applied instead. Define the estimated 
angular velocity tracking error as 

e n = n - QV d , (32) 

where il = R T Q is the estimate angular velocity expressed 
in the body-fixed frame. The stability properties of the corre¬ 
sponding combined observer and controller are summarized 
as follows. 

Proposition 4: Consider the attitude dynamics given by 
GL0 with the angular velocity observer given by 
(Hi. The control input is chosen as 

u — kReR -f JoQtld -p QQd(JoQ^d')> (33) 

for positive constants kR , kn £ R. Assume that the inertia 
matrix Jo of the rigid body and the weighting matrix Ge 
satisfy 

Am ^ tr[Gs] 

v ijG^p 


where ’T £ R is the tracking attitude error function; 
eR, ea £ R 3 are the tracking attitude error vector and 


( 34 ) 




Let il>E be a positive constant satisfying tpE < 
min{ni, ^{\x[Ge\ — t^HGsII)}. Also, assume that the initial 
conditions satisfy 

^ E (0) <tp E < min{m, i(tr[G B ] - ^-||G E ||)}, (35) 

||e„ E (0)H 2 <kE(il>E-*E(0)). (36) 

Then, the desired equilibrium given by ( R, Cl, R, Cl) = 
(Rd,Cld, R,Cl) is exponentially stable. 

Proof: See Appendix. ■ 

This proposition implies a separation property that the 
presented angular velocity observer guarantees exponential 
stability even when combined with an attitude tracking 
control system. Unlike [ 6 ] where a switching logic, that 
may cause frequent switchings, is introduced, the trajectories 
along the presented velocity-free attitude control scheme 
is free of discontinuities. This is critical in practice, as 
illustrated by numerical examples in the next section. 

While the performance of the angular velocity observer 
presented in the previous section is independent of the 
inertia matrix, the ratio of the maximum eigenvalue to the 
minimum eigenvalue of the inertia matrix should satisfy 


(34 1 for the separation property when combined with the 


attitude tracking control system. Most of existing spacecraft 


satisfy the assumption < 34 1 , and several numerical studies 


show that the separation property still holds even for various 
elongated rigid bodies that do not satisfy (34) . Extension of 
the presented results to eliminate ([34) is referred to as future 
investigation. 


V. Numerical Examples 

To illustrate the performance of the presented angular 
velocity observer, we consider two cases for attitude sta¬ 
bilization and attitude tracking. 

A. Attitude Stabilization 

We first consider a case of detumbling a rigid body, 
where the desired attitude and angular velocity are given 
by Rd = I3X3 and Cld = 0. The inertial matrix is given 
by Jo = diag[5, 1, 2] kgm 2 . The initial condition is specified 
as f?(0) = exp(7r/4ei) and f2(0) = [1, —1.5, 2.5] rad/sec 
where e\ = [1 0 0] T . The matrix G and G j- are selected 
to be G = Ge = diagfl.l, 1, 0.9]. In particular, the control 
gains are given by kR = 16Jo, fcn = k v = 5.6Jo> an d 
kE = lOJo- Note that the controller gains kR,kn,k v are 
given to be scalars throughout this paper but they can be 
easily generalized to symmetric positive definite matrices. 
Numerical result of the proposed observer is illustrated at 
Fig [T] which exhibits excellent convergence properties. 

For a comparison, the angular velocity observer and 
controller presented [6] are applied as well, and the cor¬ 
responding numerical results are illustrated at Fig. [2] As it 
is developed in terms of quaternions, the attitude estimation 
error and the attitude tracking error are plotted as the scalar 
part and the vector part of quaternions. It is shown that 
there are frequent switchings when t < 3 seconds, and the 
corresponding control input has high-frequency oscillations. 




Ld — LJ 




(c) Attitude stabilization error e# (d) Angular velocity stabilization er¬ 
ror en 



Fig. 1. Attitude stabilization with the presented angular velocity observer 
on SO(3) 


B. Attitude Tracking 


Next, we consider an attitude tracking problem. The 
desired attitude is given in terms of 3-2-1 Euler angles as 
R d (t) = R d {a{t), /3(t), 7 (f)) where a(t), and 7 (f) 
are chosen as 1, sin(0.05t) and cos(O.lt) + 2, respectively. 
The initial conditions and control gains are identical to the 
attitude stabilization example. The corresponding results are 
illustrated at Fig. [3] where both the estimation errors and the 
tracking errors converge to zero nicely. 

However, when the switching angular velocity [ 6 ] is 
applied to the same tracking problem, there are persistent 
switchings over the entire simulation period as illustrated 
by Fig. 0 and the estimation errors and tracking errors do 
not converge for the given simulation period of 40 seconds. 
Such frequent switchings or high-frequency oscillations in 
the control moment may excite unmodelled dynamics or 
increase sensitivity to noise. These comparisons illustrate 
the desirable numerical properties of the proposed angular 
velocity observer explicitly. 
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(a) Attitude estimation error (scalar 
part of quaternion) 



(b) Attitude estimation error (vector 
part of quaternion) 




(b) Angular velocity estimation error 

UJ — LJ 






(c) Angular velocity estimation error (d) Control moment u 

Q — Cl 


(c) Attitude tracking error e# (d) Angular velocity tracking error 

en 



(e) Attitude stabilization error (scalar 
part of quaternion) 



Attitude stabilization error (vector 
t of quaternion) 



Fig. 2. Attitude stabilization with the switching angular velocity observer 
in [6] 


Fig. 3. Attitude tracking with the presented angular velocity observer on 
SO(3) 


Appendix 

Proof of Proposition^] 

For the weighting matrix G = diag \g\, 52 , 32 ] of the 
control system given at ( |23f l, let ^ be a positive constant 
satisfying ^ < min {g 2 + 53 , S 3 + 01,01 + 02 }- Consider 
the following domain for the configuration of the attitude 
dynamics and the observer: 


D = {(R, Q, R, Q) e (SO(3) x R 3 ) 2 | $ < tjj, < ip E }, 

The subsequent stability proof is developed in this domain. 
We first show that the estimated attitude and angular velocity 
trajectories starting from the initial conditions satisfying ( [35] ) 
and (36 1 satisfy d > E < 4>e always, i.e., the estimated trag- 
ictory stay in the domain D. Recall the Lyapunov function 
U given at ( |20| . For the initial estimates R(0) and u>(0) 
satisfying (|35[) and ( [36] ), we have 

U{ 0) < k E {i>E — ’L.e(O)) + tt f _E(0) = k E ii) E . 


As U(t) is non-increasing from (21 1 , we have 


k E ^ E (t) < U(t) < U{ 0) < k E i/j E , 


which yields 

V E (t) <ip E < min{m, i(tr[G s ] - ^||Gs||)} 

Z A rn 

for all t > 0. 

Consider the following Lyapunov function 

V = V c + Vo, (37) 


where V c and V 0 are related to the controller and the 
observer, respectively, and they are defined as 

V c = -e^ Joen + &it^ + cieJJoen, 

V 0 = U — C 2 eJ lE en E = ||e^ B || 2 + k E ^ E — C 2 eJ ]E en E , 

for positive constants Ci and c 2 . It has been shown that 
V c is positive definite about (en,e E ) = (0,0) when ci is 
sufficiently small, and it satisfies 

a T M\a < V c < a T M 2 a, (38) 


where a = [||en||, ||e/{||] T £ R 2 , and the matrices M 1; M 2 £ 
R 2x2 are defined as 


Mi 


1 

2 


Am 

—ci Am 


—ci Am 
2bik E 


M 2 


1 

2 


Am 
ci Am 


ci Am 

262 /C-R 
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(a) Attitude estimation error (scalar (b) Attitude estimation error (vector 
part of quaternion) part of quaternion) 



(c) Angular velocity estimation error 

Q — Cl 
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100 0 10 20 30 40 
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(d) Control moment u 



Time (sec) Time (sec) 


(e) Attitude tracking error (scalar part (f) Attitude tracking error (vector part 
of quaternion) of quaternion) 


The following properties of the error variables has been 
shown in [4]: 

ll^cll < ^tr[G], 

llxll < A M ||en|| + B{, 

\\e R \\<B * 2 4 1 ^ 12^2 + 3 ^, 
where the constants p 2l p 3 are defined as 

p 2 = max{ (gi - g 2 ) 2 , (g 2 - gsf , (#3 - gi) 2 }, 
p 3 = max{(g! + g 2 ) 2 , (g 2 + ff 3 ) 2 , (ff 3 + 3i) 2 }- 
Applying these bounds to ( [41] ). we obtain 

V c < —fe(en + cie_R) T eo — cik R \\e R \\ 2 
+ (v / 2tr[G] + f? 2 )||en|| 2 

+ c 1 (A:n + B 1 *)||efl||||en||. (42) 

From d9} and the second part of <[TJ, we can write e WE = 
RJ 0 R'Tuj — ui). Therefore, we have 

B T e u]E = JqB 7 (to -u>) = J 0 (n - fi), 

which follows that 

Q = fl- J^R T e UB . 

From this, the angular velocity error vector given by ( [32] ) 
can be rewritten as 

en = en- jQ 1 R T e UJE . (43) 


Fig. 4. Attitude tracking with the switching angular velocity observer in [6] 


for a constant bi , b 2 that can be determined by the weighting 
matrix G and ip [ 3]. 

Similarly, from (13 i, the second part of the Lyapunov 
function satisfies 


£ T M 3 £ < V G < £ T M 4 £, (39) 

where £ = [||e fiE ||, ||e WE ||] T £ R 2 and 
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If the constant c 2 is chosen sufficiently small such that 


C 2 < min{2 


k E ni 


kEniiM 


n 2 


+ n 3 V ^(nx-ipE) 


}, 


(40) 


then the matrices M 3 and M 4 are positive definite. From 
these, the Lyapunov function V is positive definite about 
{eQ.,e R ,e bjE ,e RE ) = (0,0, 0,0) and it is decrescent. 

From ([26])-([28]) and ( [33} , the time-derivative of V c is 


Vc = (en + cie^) T J 0 en + k R ^> + ciej J 0 en 
+ k R e R e n + c 1 (E c en) T J 0 e n 
= -fcn(en + cie_R) T en — cifcfl||e_R|| 2 
+ cie^xen + ci(E c en) T Joen- 


Substituting (43 i into ([42}, we obtain 

Vc < — -B 3 ||en|| 2 - cik R \\e R \\ 2 + c 4 (fcn + i?})||e_R||||eo|| 

(44) 


+ fcf 2 T— I|en 

Am 


+ cifcnT— ||eje 
Am. 


where B* = [k n - ^(^2tr [G] + B*)]. 

Next, we find the time-derivative of V Q . From 0 and 
properties (v), (vi) of Proposition [T] we have 

V 0 U — c 2 e UE e RE — c 2 e UJE e RE 

= U+ -c 2 k E e T RE J~ l e RE 

— ^ c 2 e ! E (tr[Q eGE\ hx3 ~ Q e Ge)we- (45) 

Equation ( [14} can be rewritten as 

ui E = J _1 [J(w - w) - k v e RE ] 

= J~ 1 {e ulE - k v e RE ). (46) 


Substituting ([46]) and pT) into ([45]), we obtain 


Vo<-( 


-( 


rv v ^2 

Am 2A m 
tr [QeGe\ 


Am 
tr [QeGe] 


)MKJ 2 

II Ge II 3 °2l 1+2 

) 2 


Am 

\\Ge\\ 


2X„ 


c 2 k v 


\ e R E 


(41) 


(47) 































































Combining (44 1 and ( [47] ), the time-derivative of the Lya¬ 
punov function satisfies 

v < -S ||e„f - |m|«I| 2 + ct(k a + BDIMIMI 




ett| 


- 


-®3 Ip II 2 i 

^-|en|| + -— 

Z A m 

‘2k v \ m C 2 \m 


en 




C2^4b | 

6A M^m 
C 2 A E M 2 


2 Am A m 

C 2 k v ,, | 

+ W7— B E\\e UE \ 
ZA rn 


^s||eii E || 2 - 


BAmA™ a 

C2 2 4_e 2 


6Am A„ 


|LRe 


where = tT[Q E G E }X m - ||G b ||Am € K and B E = 
tr[Q E G E ] + \\G E \\ € R. Note that (34) ensures that A E > 0. 
This is rearranged as the following matrix form: 


V < -a T VLia - 0' W 2 0 - C W 3 C - C W 4 C. 


where a = [||en||, ||e jR ||] T , 0 = [He^H, ||e WB ||] T , C = 
[||en||, ||e WE ||] T , C = [||ejj E [|, ||e^ B ||] T £ R 2 and the matrices 
are defined as 
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The constants ci, C 2 and the controller gains can be chosen 
such that all of the above matrices are positive-definite. For 
example, if the constant C\ is chosen such that 


, . r 2fc a c 2 k R \ 2 m A E 

Ci < mm { -=-, -,,, - 

1 Am (\/2tr [G] + B*) 3fc^A M 

_2 fcflfcp_ 

fcfiAM(v / 2tr[G] + B 2 ) + 2(fc n + ^i) 2 


(48) 


then the matrices Wi and W 2 are positive definite. Condi¬ 
tions on C 2 to guarantee the positive-definiteness of W 3 and 
W 4 can be derived similarly. Therefore, the zero equilibrium 
of the tracking errors and estimation errors is exponentially 
stable. 
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